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tels vorbestimmter Algorithmen, denen ein Fehlermodell 
zu Grunde liegt, Korrekturdaten ermittelt werden, die der 
Steuerelektronik des Roboters zugefuhrt werden, um so- 
mit den durch TemperatureinfluB bedingten Positionier- 
fehler des Wirkpunktes der Roboterhand (TCP) zu korri- 
gieren. 



@ Verfahren zum Verringern des Einflusses von Tern peratu rand erungen auf Industrieroboter 
® Verfahren zum Verringern des Einflusses von Tempera- 

turanderungen auf Industrieroboter, wobei im Arbeits- 

raum eines Roboters Referenzme&punkte angeordnet 

sind, die von dem Roboter zu vbrbestimmten Zeiten und/ 

oder nach vorbestimmten Kriterien angefahren werden, 

um den Roboter zu kalibrieren, wobei die aktuellen Daten 

der Referenzmeftpunkte von einem Rechner nach vorbe- 

sti mmten Algorithmen verarbeitet werden, um Korrektur- 
daten zu gewinnen, die der Steuerelektronik des Roboters 

zugefuhrt werden, wobei 

- in einem nullten Verfahrensschritt eirie genaue Vermes- 
sung des Wirkpunktes der Roboterhand (TCP) im Arbeits- 
raum des Roboters unter definierten Bedingungen durch- 
gefuhrt wird, wobei der Einfluft von Temperaturanderun- 
gen weitgehend vermieden wird, und diese Mefiwerte die 
Ausgangsbasis fur die Korrektur. der temperaturbeding- 
ten Abweichungen bilden, 

- in einem ersten Verfahrensschritt der Roboter betriebs- 
typisch belastet wird, um im Roboter betriebstypische Er- 
warmungen zu generieren, wobei an einer Vielzahl von 
uber den gesamteh Arbeitsraum des Roboters verteilten 
Meftpunkten, die translatorischen und/oder rotatorischen 
Abweichungen Ay des Wirkpunktes der Roboterhand 
(TCP) vom jeweiligen Sollwert ermittelt werden, 
wobei der nullte und der erste Arbeitssch ritt nur einmal 
oder in groSeren Zeitabstanden ausgefuhrt werden, 

- in einem zweiten Verfahrensschritt aus der Menge der 
im ersten Verfahrensschritt ermittelten Abweichungen 
nach vorbestimmten Kriterien signifikante, temperaturde- 
terminierte Abweichugen A^ ermittelt werden, die eine 
erste Untermenge U1 bilden, 

- in einem dritten Verfahrensschritt im Arbeitsraum des 
Roboters temperaturstabile Referenzpunkte RP^ in den 
Raumkoordinaten der Untermenge U1 oder in deren 
Nahe angeordnet sind und diese zwischen den Arbeitsak- 
tipnen des Roboters nach einem vorbestimmten Zyklus 
angefahren werden, wobei die aktuellen. temperaturbe- 
dingten Abweichungen des TCP vom Sollwert ermittelt 
werden, und 

- in einem vierten Verfahrensschritt die ermittelten tern- 
peraturbedingten Istabweichungen yon den jeweiligen 
Sollwerten einem Rechner zugefuh rt werden, wobei mit- 
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Beschreibung 



Die Erfindung betrifft ein Verfahren zum Verringern des 
Einflusses von Temperatiiranderungen auf Industrieroboter, 
wobei die Positioniergenauigkeit der Industrieroboter ver- 
bessert wird. 

Mit steigenden Genauigkeitsanforderungen und der For- 
derung nach stabilen und robusten ProzeBverlaufen sind 
hohe Anspruche in bezug auf die zeitunveranderliche Wie- 
derholgenauigkeit und die Positioniergenauigkeit verbun- 
den. Besonders im Dauerbetrieb ist eine Drift der Positio- 
niergenauigkeit festzustellen, deren Ursache innere und au- 
Bere Warmequellen sind, die eine Verformung der kinemati- 
schen Kette des Roboters bewirken. 

Es ist aus prinzipiellen technischen Griinden nicht rndg- 
lich, Temperaturanderungen der kinematischen Kette des 
Roboters zu verhindern. Obwohl der EinfluB auBerer War- 
mequellen durch eine konstante Raumtemperaturprinzipiell 
minimiert werden kann, ist es technisch nicht moglich, die 
inneren Warmequellen zu beseitigen, da diese beim Betrieb 
des Roboters entstehen. So generiereri insbesondere die An- 
triebsbaugruppen Warme, die sich durch Warmeleitung in 
der kinematischen Kette verteilt, was zu zeitabhangigen 
Langen- und Winkelanderungen derselben fuhrt. Der Ein- 
fluB von Temperaturgradienten ist auch durch eine thermo- 
symmetrische Konstruktion der kinematischen Kette nicht 
vollstandig zu verhindern. 

Aus dem Stand der Technik ist bekannt, an ausgewahlten 
Stellen der kinematischen Kette TemperaturmeBstellen vor- 
zusehen, wobei in einem Speicher Korrekturwerte zur Kor- 
rektur der Lage des TCP abgelegt sind. Dieses Verfahren er- 
fordert einen hohen meBtechnischen Aufwand und hat sich 
in der Praxis nicht bewahrt. 

Weitere Vorrichtungen zur Temperaturkompensation wer- 
den in den folgenden Dokumenten beschrieben. 

Die US 4,668,157 ofTenbart einen Industrieroboter mit ei- 
ner Vorrichtung zur Temperaturkompensation. Der Kali- 
brierzyklus wird ausgelost, wenn die Temperatur an vorbe- 
stimmten Stellen der Armelemente des Roboters einen vor- 
bestimmten Wert erreicht. Das Korrekturverfahren selbst ist 
jedoch nicht beschrieben. 

Die US 5,400,638 offenbart eine Vorrichtung zum Kali- 
brieren eines Roboters, bei der thermisch unveranderliche 
Referenzkorper zum Einsatz kommen. Es werden die ther- 
misch bedingten Armlangenanderungen mittels der Me- 
thode der kleinsten Fehlerquadrate ermittel, wobei Winkel- 
anderungen unberucksichtigt bleiben. Das Korrekturverfah- 
ren ist nicht so ausfuhrlich beschrieben, daB daraus ein 
Fachmann bezuglich der Temperaturkompensation eine 
vollstandige technische Lehre entnehmen kann. 

Aus der DE 33 02 063 ist eine Einrichtung zur EinfluB- 
groBenkompensation an Werkzeug- oder MeBmaschinen so- 
wie an Industrierobotern bekannt, wobei vorgeschlagen 
wird, Korrekturwerte fur alle moglichen Positionen, thermi- 
schen Zustande und Lastbedingungen an einem Industriero- 
boter zu ermitteln. Es hat sich gezeigt, daB die gegebene An- 
weisung, an ausgesuchten Stellen eines Industrieroboters 
Temperatursensoren anzuordnen, nicht zu dem erwunschten 
Ergebnis fuhrt, da es sehr kompliziert oder aufwendig ist, 
mittels geeigneter Regressionsverfahren aus den gemesse- 
nen Temperaturen die tatsachlichen Verlagerungen zu be- 
stimmen, denn es mussen die raumlichen und zeitlichen 
Wirkungen sich iiberlagernder externer und interner War- 
mequellen in einem mathematischen Modell erfaBt werden, 
oder es mussen extrem viele Werte gewonnen werden, deren 
Ermittlung, Speicherung und Verarbeitung einen praktisch 
nicht akzeptablen Aufwand erfordern. 

Zusammenfassend ist festzustellen, daB es sich als prak- 



tisch unmoglich oder auch als viel zu aufwendig erwiesen 
hat, einen Temperatursensor am und/oder im Roboter so an- 
zuordnen, daB die gemessenen Temperaturen in einer meB- 
technisch verwertbaren Korrelation zu der tatsachlich auf- 
5 tretenden Lageverschiebung des TCP vom Sollwert steht. 
Es ist die Aufgabe der Erfindung, die Positioniergenauig- 
keit eines Roboters zu verbessern, um die vorstehend ge- 
nannten Probleme zu beseitigen. 

Die Aufgabe wird mit einem Verfahren nach Anspruch 1 
10 gelost. 

Danach sind im Arbeitsraum des Roboters ReferenzmeB- 
punkte angeordnet. Das Verfahren wird nach folgenden Ver- 
fahrensschritten durchgef uhrt: 

In dem nullten Verfahrensschritt wird zur Ermittlung der 
15 temperaturbedingten Abweichungen eine genaue Vermes- 
sung des TCP im Arbeitsraum des Roboters unter definier- 
ten Bedingungen durchgefuhrt. Dabei wird sichergestellt, 
daB der EinfluB von Temperaturanderungen weitgehend ver- 
mieden wird. Das wird z. B. dadurch erreicht, daB der Robo- 
20 ter bei konstanter AuBentemperatur und nur ganz langsam 
bewegt wird, so daB von den Antrieben nur wenig Warme 
generiert wird. Die dabei gemessenen Werte und ermittelten 
Parameter bilden die Ausgangsbasis fur die Korrektur der 
temperaturbedingten Abweichungen. 

25 

- In dem ersten Verfahrensschritt werden an einer 
Vielzahl von MeBpunkten, die iiber den gesamten Ar- 
beitsraum des Roboters verteilt sind, die von der Tem- 
peratur bedingten translatorischen und/oder rotatori- 

30 scnen Abweichungen des TCP vom Sollwert unter vor- 
bestimmten betriebstypischen thermischen Belastun- 
gen ermittelt. Dieser Verfahrensschritt ist sehr zeitauf- 
wendig und wird nur einmal oder in groBeren Zeitab- 
standen durchgefuhrt. 
35 - In einem zweiten Verfahrensschritt werden aus der 

Menge der im ersten Verfahrensschritt ermittelten Ab- 
weichungen nach vorbestimmten Kriterien die Kobrdi- 
naten der MeBpunkte ermittelt, die groBere Abwei- 
chungen aufweisen. Diese MeBpunkte bilden die Un- 
40 termengeUl. 

- In einem dritten Verfahrensschritt werden im Ar- 
beitsraum des Roboters temperaturstabile Referenz- 
punkte RPui in den Raumkoordinaten der Untermenge 
Ul oder in deren Nahe angeordnet. Diese besonders 

45 temperaturempfindlichen Punkte werden zwischen den 

Arbeitsaktionen des Roboters nach einem vorbestimm- 
ten Zyklus angefahren. Dabei werden die aktuellen 
temperaturbedingten Abweichungen A D1 des Wirkor- 
tes des Endeffektors, nachfolgend als TCP bezeichnet, 
50 vom Sollwert ermittelt. 

- In einem vierten Verfahrensschritt werden die ermit- 
telten aktuellen temperaturbedingten Istabweichungen 
der Steuerelektronik des Roboters zugefuhrt. Die Steu- 
erelektronik korrigiert dann den durch Temperaturein- 

55 fluB bedingten Positionier- oder MeBfehler des TCP 
vom Sollwert. 



Nach Anspruch 2 entfallt der nullte Verfahrensschritt. 
Dem Fachmann ist klar, daB der nullte Verfahrensschritt ent- 
60 fallen kann, wenn die in diesem Verfahrensschritt zu ermit- 
telnden Werte fiir einen bestimmten Robotertyp entweder 
bekannt sind oder als vernachlassigbar klein angesehen wer- 
den konnen. 

Bei einem Verfahren nach Anspruch 3 wird das Verfahren 
65 nach Anspruch 1 oder 2 insofern weitergebildet, daB aus der 
ersten Untermenge Ul eine weitere Untermenge U2 ermit- 
telt wird. Diese Untermenge U2 enthalt Raumpunkte, die 
noch temperaturempfindlicher sind als die Raumpunkte der 
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Untermenge Ul. Je nach Bedarf und technologischen An- 
forderungen konnen die Punkte dieser zweiteri Untermenge 
U2 haufiger als die Punkte der ersten Untermenge Ul ange- 
f ahren werden. Falls sich bei diesen Punkten unzulassig . 
groBe Abweichungen der Istposition des TCP von seiner 5 
Sollposition einstellen, kann entweder sofort korrigiert wer- 
den oder es werden alle Punkte der Untermenge Ul ange- 
fahren und anschliefiend korrigiert. 

Bei einem Verfahren nach Anspruch 4 werden weitere, 
hierarchisch gestaffelte Untermengen gebildet. Es ist somit 
letztlich auch moglich, in Abhangigkeit von der Arbeitsauf- 
gabe des Roboters, nur einen einzigen, besonders tempera- 
turabhangigen Punkt auszuwahlen und diesen haufiger zu 
uberwachen. Falls sich bei diesem Punkt eine unzulassig 
groBe Abweichung der Istposition des TCP von seiner Soli- 
position einstellt, kann wiederum entweder sofort korrigiert 
werden, oder es werden die Punkte der jeweils dariiber lie- 
genden Untermenge angefahren und anschlieBend korri- 
giert. Falls die Anforderungen an die Positioniergenauigkeit 
erhoht werden und der technologische Ablauf es zulaBt, 20 
konnen die verschiedenen Ebenen der Untermengen frei ge- 
wahlt werden. * 

Bei einem Verfahren nach Anspruch 5 wird der TCP so 
gewahlt, daB auch solche temperaturbedingten Abweichun- 
gen, die durch Veranderung der Werkzeuggeometrie entste- 25 
hen, mit erfaBt werden. Beispielsweise wird bei einer 
SchweiBzange deren Arbeitspunkt eingemessen und nicht. 
die Einspannstelle der SchweiBzange, da bei betriebsbe- 
dingter Erwarmung der SchweiBzange eine Langen- bzw. 
Geometrieanderung derselben eintritt. ' 30 

Bei einem Verfahren nach Anspruch 6 werden die zur . 
Korrektur des TCP ermittelten Abweichungen mit gespei- 
cherten Werten verglichen, wobei nach vorbestimmten Kri- 
terien entschieden wird, ob die aktuellen Abweichungen be- 
triebstypische Abweichungen sind, die auf Temper aturein- 35 
fliisse zuriickzufiihren sind, oder ob die aktuellen Abwei- 
chungen eine andere Ursache haben. Diese Ursache kann 
z. B. ein mechanischer Defekt. oder ein zu hoher VerschleiB 
von Getriebeelementen sein. Wenn eine abnorme, d. h. eine 
untypische Abweichung festgestellt. wird, erfolgt eine Si- 40 
gnalausgabe, die auf den abnormen Fehler hinweist, der 
nicht. auf TemperatureinfluB zuruckzufuhren ist. 

Es ist. als besonderer Vorteil herauszuheben, daB das erfin- 
derische Verfahren unabhangig vom Bautyp des Roboters 
anwendbar ist. Weiterhin kann die Erfindung sowohl bei 45 
neuen als auch bei Robotern, die bereits im Einsatz sind, an- 
gewendet werden. 

Die Erfindung wird nunmehr an Hand eines Ausfuhrungs- 
beispiels und einer beigefugten Zeichnung naher erlautert. 

Fig. 1 zeigt eine Ausfuhrungsform eines Programmab- 50 
laufplans des erfindungsgemaBen Verfahrens. 

Nachfolgend wird die in der Praxis ubliche Vorgehens- 
weise zur Anwehdung der Erfindung an einem sechsachsi- 
gen Vertikalknickarmroboter mit offener kinematischer . 
Kette und mit geschlossener Viergelenkkette zur Steuerung 55 
der zweiten und der dritten Achse beschrieben. 

1 . Anwendung des erfindungsgemaBen Verfahrens ein- 
schlieBlich der Generierung des Fehlermodells vor dem Pro- 

duktionseinsatz 60 

1.1. Erforderliche Ausriistungen fur die Besummung des . 
Fehlermodells am Roboter 

- Industrieroboter mit Steuerung, .65 

- Beruhrun'gsloses 3D-EntfernungsmeBsystem (Laser- 
trackersystem) zur Ermittlung der absoluten Positions- 
daten, . 
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- PC mit Kalibriersoft ware zur Positionsdatenerf as- 
sung sowie zur Modellierung, Identifikation und Aus- 
wertung der Modellparameter. 

1.2. Generierung des Fehlermodells 

Das Vorgehen zur Generierung des Fehlermodells laBt 
sich in folgende drei Teilschritte gliedem: 

10 - Modellbildung: Beschreibung der Endeffektorpose 
(Position und Orientierung) des Roboters durch eine 
Funktion der Stellung der Bewegungsachsen und der 
zu berechnenden Modellparameter, 

- Messung: Prazise Vermes sung der Position des End- 
is effektors in ausgewahlten Arbeitsraumpositionen, 

- Identifikation: Numerische Berechnung der Modell- 
. parameter, ausgehend vom nominalen Modell, so daB 

Positions- und Bahnabweichungen zwischen Modell- 
funktion und Messungen minimal werden. 

1.2.1. Modellierung statischer und dynamischer Parameter 

Zur Bewegungsplanung des hier beschriebenen Industrie- 
roboters wird ein sogenanntes nominales Modell eingesetzt. 
Die Beschreibung der Endeffektorpose erfolgt dabei durch 
Transformationsmatrizen, die sich aus den Winkelwerten 
der sechs AchsmeBsysteme und den aus den Konstruktions- 
zeichnungen des Roboters bekannten Achslangen (Nenn- 
maBe) ergeben. 

Zur exakteren Beschreibung des realen Roboters wird mit 
Hilfe der Kalibriersoftware ein erweitertes mathematisches 
Modell, das sog. Fehlermodell, . zusammengestellt. Dieses 
Modell beschreibt die Pose des Endeffektors als Funktion 
der Winkelwerte der sechs Drehachsen und der spater bei 
der Identifikation zu quantifizierenden Parameter des Feh- 
lermodells. 

Die Modellierung beinhaltet folgende station are Pararne- 
ter (Abbildung von kpnstruktions-, fertigungs- und monta- 
gebedingten FehlergroBen): 

- Lange. der einzelnen Achselemente (Sockel, Unter- 
arm, Oberarm, Hand) 

- Schiefwinkligkeit von je zwei der Bewegungsachsen 
zueinander, 

- Nullagenfehler der WinkelmeBsysteme der Drehach- 
sen, 

- Getriebefehler (Exzent.rizitat, Elastizitat und Spiel), 

- Gelenkungenauigkeiten (Elastizitat und Spiel) sowie 

- Lastein fliisse (Bauteilelastizitat). 

Die Zusammensetzung der zu identifizierenden Parame- 
ter kann vom Anwender frei gewahlt werden. Die Genauig- 
keitssteigerung ist dabei mit steigender Anzahi der verwen- 
deten Parameter zunehmend. 

Zur Modelberung des thermischen Zustands der Roboter- 
kinematik und der daraus resultierenden Temperaturdrift 
sind folgende dynamische Parameter im Fehlermodell be- 
riicksichtigt: 

- Thermisch bedingte Achslangenanderungen, 

- Anderung der S chief winkligkeit der Bewegungsach- 
sen aufgrund thermisch bedingter zwei- und dreidi- 
mensionaler Verformungen der Achselemente, 

- GetriebeungenauigkeitenAungleichmaBigkeiten auf- 
grund thermisch bedingter Verspannungen bzw. der 
Spielveranderung, 

- Variables Gelenkspiel aufgrund thermischer Ver- 
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spannungen der Drehachsenlagerungen. 

1 .2.2. Messung der Positioniergenauigkeit des Industriero- 
boters 

Mit Hilfe des Lasertrackersystems wird die Absolutge- 
nauigkeit des Roboters im Arbeitsraum bestimmt. Die ge- 
messenen Endeffektorpositionen sind zusammen mit den 
aus der Robotersteuerung bekannten norninalen Posen die 10 
Eingangsdaten zur Berechnung der Modellparameter. 

Bei der Auswahl der zu messenden Endeffektorpositio- . 
nen ist darauf zu achten, daB diese iiber den gesamten Ar- 
beitsraum gleichmaBig verteilt sind. Je groBer das fur die 
Messungen ausgenutzte Arbeitsraumvolumen ist, um so ex- 15 
akter kann die Berechnung der Modellparameter erfolgen. 

Der Detaillierungsgrad des Fehlermodells (Anzahl der zu 
idenufizierenden Parameter) legt die benotigte Anzahl der 
zu messenden Posen fest. 

20 

1.2.3. Identifikation der stationaren Parameter 

Zur Bestimmung der stationaren Parameter (konstrukti- 
ons-, fertigungs- und montagebedingte FehlergroBen) des 
Fehlermodells werden die unter 1.2.2. festgelegten Arbeits- 25 
raumpositionen unter stationaren Bedingungen mit dem Ro- 
boter angefahren und gemessen. Zur Identifikation der unter 
1.2.1. aufgelisteten Parameterarten sind bei dem betrachte- 
ten Roboter insgesamt 100 verschiedene Referenzposen zu 
messen. 30 

Die Identifizierung der Parameter erfolgt: 

- bei gleichbleibender Raumtemperatur (20°C ±2K), 

- unter Nennlast (an der Roboterhand) und 

- unter Verwendung einer Bahngeschwindigkeit von 35 
25 mm/s beim Anfahren und Verfahren zwischen den 
MeBposen (Vermeidung signifikanter Verlustleistun- 
gen in den Antrieben durch geringe Verfahrgeschwin- 
digkeit). 

40 

Die zu messenden Positionen werden mit dem Roboter 
exakt (ohne Uberschleifen) angefahren, mit dem Lasertrak- 
ker absolutgenau zum Roboterbasiskoordinatensystem ge- 
messen und zusammen mit den entsprechenden norninalen 
Positionsdaten aus der Robotersteuerung in einer Datei ab- 45 
gelegt. 

Die aus diesen Daten nurnerisch berechneten stationaren 
Parameter beschreiben das reale Robotermodell (stationares 
Fehlermodell) und bilden die Bezugsbasis fur die anschlie- 
Bende Identifikation der dynamischen Parameter (thermisch 50 
bedingte FehlergroBen). 

1.2.4. Identifikation der dynamischen Parameter 

Zur Identifikation der dynamischen Parameter miissen die 55 
in 1.2.2 festgelegten Referenzposen regelmaBig in soge- 
nannten MeBzyklen angefahren werden. Die Bahnge- 
schwindigkeit zwischen den einzelnen MeBpunkten betragt 
v = v max [mm/s]. 

Zwischen den einzelnen MeBzyklen wird der thermische 60 
Zu>stand der Roboterstruktur durch ein Belastungsprogramm 
systematisch verandert. Dazu wird der Roboter permanent 
rnit v = Y max [mm/s] zwischen zwei Arbeitsraumpunkten be- 
wegt. Zwischen diesen Arbeitsraumpunkten uberstreicht 
jede Drehachse einen Winkel von 60°. Durch die Last an der 65 
Roboterhand (Nennlast, vgl. 1.2.3) wird eine maximale Be- 
lastung und damit eine starke Erwarmung aller Achsen ge- 
wahrleistet. 
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Dieses Belastungsprogramm wird alle 10 min durch ei- 
nen MeBzyklus fur ca. 1 min unterbrochen und bis zum Er- 
reichen des thermischen Beharrungszustandes zyklisch wie- 
derholt. Der Beharrungszustand ist bei dem betrachteten 
5 Roboter nach ca. 6 bis 8 h erreicht. Die gemessenen ther- 
misch bedingten Positionsabweichungen (Temperaturdrift) 
werden fur jeden MeBpunkt in einer Datei abgespeichert. 

Nach Erreichen des Beharrungszustandes werden die ge- 
sammelten Positionsabweichungen mittels der Kalibrier- 
software ausgewertet. 

Die Temperaturdrift an jedem MeBpunkt und die entspre- 
chenden norninalen Positionsdaten aus der Robotersteue- 
rung sind Eingangsdaten zur Berechnung der dynamischen 
thermischen Parameter. 

Ergebnis dieser Auswertung ist ein Katalog variabler Pa- 
rameter, die die Veranderung der Auspragung der stationa- 
ren Parameter in Abhangigkeit des thermischen Zustandes 
und der Untersuchungsdauer beinhaltet. 

1.2.5. Auswahl signifikanter dynamischer Parameter 

Mit Hilfe statistischer Auswerteverfahren sind aus dem 
unter 1.2.4 erstellten Katalog diejenigen dynamischen Para- 
meter auszuwahlen, die den groBten thermisch bedingten 
Anderungsgrad und damit den groBten EinfluB auf die Tem- 
peraturdrift aufweisen. 

Abhangig vom konstruktiven Aufbau der Kinematik sind 
dies bei dem hier untersuchten Roboter die Achslangenan- 
derungen Aa, Ab, Ac, Ad, Ae, Af und die Getriebeungenauig- 
keiten in den Hauptachsen AA1, AA2 und AA3. 

Zur Kompensation der Temperaturdrift miissen diese 
neun signifikanten Parameter wahrend des Betriebs in Ab- 
hangigkeit des thermischen Zustandes aktualisieft und in die 
Bewegungsplanung des Roboters implementiert werden. 

1.2.6. Zusammenstellung des dynamischen Fehlermodells 

Nach der Identifikation der stationaren und signifikanten 
thermischen Parameter wird das dyriamische Fehlermodell 
zur exakten Bewegungsplanung aufgestellt. 

In den mathematischen Algorithmen zur Bewegungspla- 
nung werden, entsprechend der unter 1.2.1 durchgeftihrten 
Modellierung, alle stationaren Parameter eingetragen und 
als nicht veranderbar deklariert. 

Die unter 1.2.5 ermittelten signifikanten thermischen Pa- 
rameter (im vorliegenden Fall Aa, Ab, Ac, Ad, Ae, Af, AA1, 
AA2, AA3) werden hingegen als variabel deklariert. 

So kann wahrend des Betriebs in Abhangigkeit des Ver- 
formungszustandes eine; Aktualisierung dieser Parameter 
vorgenommen werden. Bezugsbasis und Startwert fur die 
ermittelten dynamischen Parameter sind die Werte, die unter 
1.2.3. als statische Parameter fur den Roboter identifiziert 
worden sind. 

1.2.7. Berucksichtigung des dynamischen Fehlermodells bei 
der Bewegungsplanung 

Zur Berucksichtigung der thermischen Parameter bei der 
Positions- und Bahnplanung muB eine Anpas sung des 
Steuerungsmodells (dynamisches Fehlermodell) erfolgen. 
Da die thermischen Parameter variabel sind, muB eine Mog- 
lichkeit zum regelmaBigen Abgleich des dynamischen Feh- 
lermodells im Betrieb geschaffen werden. 

Bei dem vorliegenden, zu kalibrierenden Roboter wird 
ein nominales Modell zur Positions- und Orientierungsbe- 
rechnung verwendet. In dieser Robotersteuerung liegt somit 
keine mathematische Beschreibung der Kinematik vor, die 
eine Berucksichtigung der ermittelten statischen und dyna- 
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mischen Parameter ermoglicht Zudem kann in der aktuellen 
Steuerungssoftware keine Veranderung von Systemparame- 
tern wahrend des Betriebs vorgenommeri werden. 

Aus diesen Griinden muB das dynamische Fehlermodell 
in einem externen PC implernentiert werden, der uber eine 5 
serielle Schnittstelle mit der Robotersteuerung verbunden 
ist. Zur Berucksichtigung der thermisch bedingten Effekte 
muB im PC ein Konverter bereitgestellt werden. In diesem 
Konverter werden mit Hilfe des dynamischen Fehlermodells 
berechnete Positionsdaten in Positionsdaten des nominalen 10 
Modells umgerechnet. 

Die so unter Berucksichtigung der dynamischen Parame- 
ter (Temperaturdrift) korrigierten nominalen Positionen 
werden dann uber die serielle Schnittstelle zur Roboter- 
steuerung iibertragen und den abzuarbeitenden Roboterpro- 15 
grammen zur Verfugung gestellt. 

2. Anwendung der Erfindung am Beispiel "MeBroboter" 

Zur flexiblen Automatisierung von MeBablaufen, bei- 20 
spielsweise in der Automobilindustrie, sollen zukunftig In- 
dustrieroboter als MeBgerate eingesetzt werden. Zur Mes- 
sung der MaBhaltigkeit von Karosserieteilen wird ein laser- 
optisches MeBsystem an der Roboterhand angeordnet, 

Einsatzhemmnis ist das unzureichende Positionierverhal- 25 
ten ~ bedingt durchi zeitvariante, betriebsabhangige thermi- 
sche Einflusse. Zur Minim ierung dieser Effekte kann das be- 
schriebene Kalibrierverfahren eingesetzt. werden. Die dafur 
notwendigen Einrichtungen und die Vorgehensweise wer- 
den nachstehend beschrieben. 30 

2.1. Einrichtungen zur Online-Kalibrierung 

Grundlage der Temperaturdriftkompensation ist die Be- 
stimmung der aktuellen Positionsabweichung des Roboter- 35 
Endeffektors an Referenzpositionen im Arbeitsraum. Zur 
Messung der translatorischen Positionsabweichung wird das 
an der Roboterhand angeordnete MeBsystem genutzt. 

Als Referenzkorper kommen Stahlwurfel zum Einsatz, 
die an Stangen aus Invarstahl mit hoher MaBbestandigkeit 40 
bei Temperaturschwankurigen im Arbeitsraum stationar po- 
sitioniert sind. , 

Zur Identification der signifikanten Parameter (vgl. 1.2.5) 
wurden insgesamt neun Referenzpositionen eingerichtet. 
Die Lage dieser Referenzpositionen ist beliebig - es ist le- 45 
diglich darauf zu achten, daB moglichst groBe Achswinkel- 
unterschiede zwischen den einzelnen Positionen realisiert 
werden. 

2.2. Kalibrierzyklus - 50 

Zur Kompensation der Temperaturdrift an den genutzten 
Arbeitsraumpositionen wird ein sog. Kalibrierzyklus mit. 
folgendem Ablauf. definiert: . 

55 

- Verfahrprogramm zur Messung der Positionsabwei- 
chung an den Referenzkorpern, 

- Berechnung der thermischen Parameter und Aktuali- 
sierung des dynamischen Fehlermodells, 

- Berechnung der korrigierten Arbeitsraumpositionen 60, 
fur.jede im Roboterprbgramm enthaltene MeBposition, 

- Konvertierung der berechneten Arbeitsraumpositio- 
nen in korrigierte nominale Arbeitsraumpositionen, 

- Ubertragung der korrigierten nominalen Arbeits- 
raumpositionen (MeBpositionen) in die Robotersteue- 65 
rung. 
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2.3. Integration der Online-Kalibrierung in den Produktions- 
prozeB 

Der ProduktionsprozeB "Vermessen von Karosserietei- 
len" wird in zwei Routinen, den Kalibrierzyklus (siehe Ab- 
schnitt 2.2) und den Arbeitszyklus (MeBbetrieb, Vermes- 
sung des Karosserieteils), gegliedert. 

Vor Produktionsbeginn (Beginn der Produktion nach Wo- 
chenenden, Produktwechsel) bzw. nach Produktionsunter- 
brechung (Aussetzbetrieb, Instandhaltung usw.) wird grund- 
satzlich eiri Kalibrierzyklus zur Aktualisierung des dynami- 
schen Fehlermodells und zur Korrektur aller MeBpunkte 
durchgefuhrt. AnschlieBend kann der MeBbetrieb (Arbeits- 
zyklus) aufgenommen werden. 

Um eine gleichbleibend hohe MeBgenauigkeit wahrend 
des Betriebs gewahrleisten zu konnen, muB ein regelmaBi- 
ger Abgleich des dynamischen Fehlermodells auf der 
Grundlage des aktuellen Verformungszustands des Roboters 
erfolgen. 

Um Nebenzeiten zu minimieren, die durch jeden Kali- 
brierzyklus bedingt sind, wird eine verformungsabhangige 
Regelung der Zeitintervalle zwischen zwei aufeinanderfol- 
genden Kalibrierzyklen eingefuhrt. 

Diese Regelung basiert auf der zyklischen Uberwachung 
der Positioniergenauigkeit des Roboters an einem der Refe- 
renzkorper. Die Uberwachung der Genauigkeit wird in den 
Arbeitszyklus integriert. Anhand der aktuellen Positionsab- 
weichung an diesem Referenzkorper erfblgt die Entschei- 
dung, ob emeut ein Kalibrierzyklus erforderlich ist oder der 
nachste Arbeitszyklus ausgefiihrt werden kann. 

Der Schwellwert wurde in dem vorliegenden Ausfiih- 
rungsbeispiel auf eine summarische Abweichung von > 
0,1 mm beziiglich der vor dem letzten Kompensationszy- 
klus gemessenen Abweichung am Referenzkorper festge- 
legt. 

Der Referenzkorper zur Uberwachung der aktuellen Posi- 
tioniergenauigkeit ist so zu positionieren, daB das Anfahren 
dieser Position gut in den Bewegungsablauf des Arbeitszy- 
klus integrierbar ist. 

Es ist dem Fachmann offensichtlich, daB das vorstehend 
beschriebene Verfahren modifiziert werden kann, ohne da- 
bei den Grundgedanken der Erfindung zu verlassen. 

Patentanspruche 

1. Verfahren zum Verringern des Einflusses von Tem- 
peraturanderungen auf Industrieroboter, wobei im Ar- 
beitsraum eines Roboters ReferenzmeBpunkte ange- 
ordnet. sind, die von dem Roboter zu vorbestimmten 
Zeiten und/oder nach vorbestimmten Kriterien ange- 
fahren werden, um den Roboter zu kalibrieren, wobei 
die aktuellen Daten der ReferenzmeBpunkte von einem 
Rechner nach vorbestimmten Algorithmen verarbeitet 
werden, um Korrekturdaten zu gewinnen, die der Steu- 
erelektronik des Roboters zugefiihrt werden, wobei 

- in einem nullten Verfahrensschritt eine genaue 
Vermessung des Wirkpunktes der Roboterhand 
(TCP) im Arbeitsraum des Roboters unter defi- 
nierten Bedingungen durchgefuhrt wird, wobei 
der EinfiuB von Temperaturanderungen weitge- 
hend verrnieden wird, und diese MeBwerte die 
Ausgangsbasis fur die Korrektur der temperatur- 
bedingten Abweichungen bilden, 

- in einem ersten Verfahrensschritt der Roboter 
betriebstypisch belastet wird, um im Roboter be- 
triebs typische Erwarmungen zu generieren, wobei 
an einer Vielzahl von uber den gesamten Arbeits- 
raum des Roboters verteilten MeBpunkten, die 
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translatorischen und/oder rotatorischen Abwei- 
chungen Au des Wirkpunktes der Roboterhand 
(TCP) vom jeweiligen Sollwert ermittelt werden, 
wobei der nullte und der erste Arbeitsschritt nur 
einmal oder in grpBeren Zeitabstanden ausgefuhrt 5 
werden, 

- in einem zweiten Verfahrensschritt aus der 
Menge der im ersten Verfahrensschritrerrnittelten 
Abweichungen nach vorbestimmten Kriterien si- 
gnifikarite, temperaturdeterminierte Abweichugen 10 
Aui ermittelt werden, die eine erste Untermenge 

• Ulbilden, 

- in einem dritten Verfahrensschritt im Arbeits- - 
raum des Roboters temperaturstabile Referenz- 
punkte RPui in den Raumkoordinaten der Unter- 15 
menge Ul oder in deren Nahe angeordnet sind 
und diese zwischen den Arbeitsaktionen des Ro- 
boters nach einem vorbestimmten Zyklus ange- 
fahren werden, wobei die aktuellen temperaturbe- 
dingten Abweichungen des TCP vom Sollwert er- 20 
mittelt werden, und 

- in einem vierten Verfahrensschritt die ermittel- 
ten temperaturbedingten Istabweichungen von 
den jeweiligen Sollwerten einem Rechner zuge- 
fiihrt werden, wobei mittels vorbestimmter Algo- 25 
rithmen, tdenen ein Fehlermodell zu Grunde liegt, 
Korrekturdaten ermittelt werden, die der Steuer- 
elektronik des Roboters zugefiihrt werden, um so- 
mit den durch TemperatureinfluB bedingten Posi- 
tionierfehler des Wirkpunktes der Roboterhand 30 
(TCP) zu korrigieren. 

2. Verfahren nach Anspruch 1, dadurch gekennzeich- 
net, daB der nullte Arbeitsschritt entfallt. 

3. Verfahren nach Anspruch 1 oder 2, dadurch gekenn- 
zeichnet, daB aus der ersten Untermenge Ul ein zweite 35 
Untermenge U2 ermittelt wird, wobei die Abweichun- 
gen Au2 der zweiten Untermenge U2 signifikanter sind 
als die Abweichungen Aui der Untermenge Ul . 

4. Verfahren nach einem der vorhergehenden Anspru- 
che, dadurch gekennzeichnet, daB weitere, hierarchisch 40 
gestaffelte Untermengen gebildet werden, deren Ab- 
weichungen jeweils signifikanter sind als die der vor- 
hergehenden Obermenge. 

5. Verfahren nach einem der vorhergehenden Anspru- 
che, dadurch gekennzeichnet, daB der TCP so gewahlt 45 
wird, daB auch die temperaturbedingten Abweichun- 
gen, die durch Veranderung der Werkzeuggeometrie 
entstehen, mit erfaBt werden, 

6. Verfahren nach einem der vorhergehenden Ansprii- 
che, dadurch gekennzeichnet, daB die zur Korrektur 50 
des TCP ermittelten Abweichungen gespeichert und 
mit vorbestimmten Werten verglichen werden, wobei 
nach vorbestimmten Kriterien entschieden wird, ob die 
Abweichungen betriebstypische Abweichungen sind, 
die auf Temperatureinfliisse zuruckzufuhren sind, oder 55 
ob die Abweichungen eine andere Ursache haben, wo- 
bei in diesem Fall ein Aufforderungssignal zur Fehler- 
suche ausgegeben wird. 
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